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(54) ROBOT CONTROLLER 

(57) A robot controller, whereby, when a point repre- 
sentative of position of a robot makes an abnormal 
motion in space, such abnormality is quickly and auto- 
matically sensed and the robot is brought to a stop. The 
robot controller (30) comprises a host CPU (31), a 
shared RAM (32), a servo CPU (33), servo amplifiers 
(34), a memory (35), an interface (36) for a teaching 
panel, and input/output devices (38). The servo CPU 
(33) periodically writes in the shared RAM (32) current 
positions of respective axes obtained from the outputs 

FIG. 1 



of position detectors. Using the written data, the host 
CPU (31) periodically creates an abnormal motion 
detection index for detecting abnormality of velocity, 
acceleration, direction of movement or position of a tool 
center point or abnormality of angular velocity of a wrist 
axis, and compares the index with an abnormal motion 
detection criterion. When an abnormal motion is 
detected, the robot is immediately stopped. 



3 0 



r 




r 


r 


BOST CPU 


nun cmuios 


1 BARED SAH 




SIBTO CFP 




si mi 










POJITIOI OF AXES 









C0UAI01 FOR 
CBSIEIT 



FOI { \ 



POIITIW OF AXES 



r 3 



I F 



I/O 

X 



ED 



(ffm 



-3 7 



■ tmiui DHtcu (hake tit) 



Primed by Xerca (UK) Business Services 
2.16.7/3.6 



EP0 927 612 A1 



Description 

Technical Field 

[0001 ] The present invention relates to a robot control- s 
ler for controlling an industrial robot, and more particu- 
larly to a robot controller having an erroneous motion 
detecting function. 

Background Art 10 

[0002] Robots used in factories and the like some- 
times make an abnormal motion due to a failure in a 
hardware component or a software defect; for example, 
a robot sometimes makes a motion at a velocity exceed- is 
ing a value specified by a program or manually specified 
by a user, or moves toward an unexpected position. 
[0003] Emergency stop buttons are provided on 
robots, but since servomotors of high power are 
mounted on recent robots, it is difficult to immediately 20 
stop a robot which has started an abnormal motion by 
merely depressing the emergency stop button. In addi- 
tion, an operator tends to be late in depressing the 
emergency stop button. 

[0004] In view of the above, there has been proposed 25 
a method in which a motion amount of each axis of a 
robot is periodically monitored by a robot controller and 
when the motion amount exceeds a predetermined limit 
value, the robot is automatically stopped, independently 
of the emergency stop button. This method, however, 30 
includes the following problems. 
[0005] In performing a path control for straight-line or 
circular-arc, it is natural that velocities of axes greatly 
differ from one another, and particularly in a control for 
a path passing near a singular point, the maximum 35 
velocity is often required for a wrist axis etc. to maintain 
a designated orientation of the robot. Therefore, it is not 
appropriate to set a lower limit value for the detection of 
abnormal motions so as to avoid erroneous detection of 
abnormal motions. Consequently, even when an unex- 40 
pected motion actually occurs, such a motion some- 
times can not be determined to be abnormal and the 
robot is unable to be stopped automatically. 
[0006] Further, with the above method, in the case 
where an abnormality occurs as to a position of a robot 45 
in motion, for example, a substantial deviation of the 
robot position from a taught path or a manual feed (jog 
feed) direction occurs, such abnormality can not be 
detected to automatically stop the robot, as long as the 
velocities of motion of the respective axes are not so 
abnormal. 

[0007] Thus, the conventional technique is not suffi- 
ciently capable of immediately and surely responding to 
robot motions (abnormal state of motion or abnormal 
position in motion), posing problems in securing safety 55 
of the operator and protection of peripheral equipment. 



Disclosure of Invention 

[0008] An object of the present invention is to provide 
a robot controller capable of immediately and automati- 
cally sensing an abnormality and stopping a robot to 
avoid danger when a point representing a robot position 
is taking an abnormal velocity, an abnormal accelera- 
tion or an abnormal motion path in space when the 
robot operates in a program playback operation mode 
or in a manual operation mode such as a jog feed. 
[0009] A robot controller according to the present 
invention comprises: abnormal motion detection index 
creating means for periodically creating an abnormal 
motion detection index for detecting an abnormal 
motion in space of a point representing a position of a 
robot based on present position data of respective 
robot axes obtained from outputs of position detectors 
of the robot axes while the robot is in motion; determina- 
tion means for comparing the abnormal motion detec- 
tion index with a predetermined reference abnormal 
motion detection reference, and determining that an 
abnormal motion has occurred when the abnormal 
motion detection index exceeds the predetermined 
abnormal motion detection reference; and stopping 
means for immediately stopping motion of the robot 
when an abnormal motion of the robot is detected by the 
determination means. 

[0010] Abnormal motion which can be detected with 
the robot controller according to the present invention is 
abnormal motion of the robot position-representative 
point during a program playback or manual feed (jog 
feed) operation, and the abnormal motions are classi- 
fied into motion abnormality types stated below. Abnor- 
malities 1 to 4 can be collectively referred to as 
"abnormality of motion" and abnormality 5 as "abnor- 
mality of position". The term "robot position-representa- 
tive point" used hin this specification denotes a point set 
in a fixed relation with respect to end effectors such as 
a robot hand, a welding torch or the like. 
[0011] Typically/the robot position-representative 
point is the origin (tool center point) of a tool coordinate 
system set with respect to an end effector to be 
mounted, or the origin of a faceplate coordinate system 
set with respect to a tool mounting face. In the following 
description, the robot position- representative point is 
set at the tool center point (TCP) for convenience sake, 
but may be set at some other point. 

(Abnormality 1) Abnormality in Moving Velocity of 

Tool Center Point: The tool center point moves at a 

velocity exceeding a limit velocity. 

(Abnormality 2) Abnormality in Acceleration of Tool 

Center Point: The tool center point moves at an 1 

acceleration exceeding a limit acceleration. 

(Abnormality 3) Abnormality in Angular Velocity of 

Wrist Axis: The wrist axis moves at an angular 

velocity exceeding a limit angular velocity. For 

example, a state in which the final axis of a 6-axis 
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robot rotates at a abnormally high velocity. 
(Abnormality 4) Abnormality in Direction of Move- 
ment of Tool Center Point: During path control, the 
tool center point moves beyond a limit in a direction 
away from the direction of a trajectory calculated 5 
from position data in the program. 
(Abnormality 5) Abnormality in moved Position of 
Tool Center Point: During path control, the tool 
center point moves beyond a limit to a position 
apart from a trajectory calculated from position data 10 
in the program. 

[0012] In a preferred embodiment of the present 
invention, all of these motion abnormalities can be 
detected, but some of the abnormalities alone may be is 
detected according to circumstances. For example, only 
abnormalities 1 and 5 may be detected, and even in this 
case many of abnormal robot motions can be detected. 
[0013] The abnormal motion detection index is cre- 
ated within the control device so as to match abnormal 20 
motion to be detected and is compared with a corre- 
sponding abnormal motion detection criterion, and if an 
abnormal motion is detected, a process for stopping the 
robot is executed. Preferably, the abnormal motion 
detection criterion is automatically created within the 25 
control device in accordance with data in a taught 
motion program or manual feed conditions. 

Brief Description of Drawings 

30 

[0014] 

FIG. 1 is a block diagram showing, by way of exam- 
ple, the configuration of principal parts of a robot 
system including a robot controller to which the 35 
present invention is applied; 
FIG. 2 is a flowchart showing an outline of a 
processing I to be executed within a robot controller 
according to an embodiment of the present inven- 
tion; 40 
FIG. 3 is a flowchart showing an outline of a proc- 
ess I) to be executed within the robot controller 
according to the embodiment of the present inven- 
tion; 

FIG. 4 is a flowchart showing an outline of a proc- 45 
ess HI to be executed within the robot controller 
according to the embodiment of the present inven- 
tion; 

FIG. 5 is a flowchart showing an outline of a proc- 
ess IV to be executed within the robot controller so 
according to the embodiment of the present inven- 
tion; 

.- FIG. 6 is a flowchart showing an outline of a proc- 
ess V to be executed within the robot controller 
according to the embodiment of the present inven- 55 
tion; 

FIG. 7 is a diagram relating to the process III; and 
FIG. 8 is a diagram relating to the process IV. 




Best Mode of Carrying out the Invention 

[0015] FIG. 1 is a block diagram exemplifying the 
hardware configuration of principal parts of a robot sys- 
tem including a robot controller to which the present 
invention is applied. As shown in FIG. 1 , a robot control- 
ler 30 controls a robot RB having a hand 10 as an end 
effector mounted to a distal end portion 1 of its arm. A 
tool center point TCP, which is a point representative of 
the position of the end effector (hand 10), is set at the 
center of the hand 10. 

[001 6] The robot controller 30 comprises a host CPU 
31, a shared RAM 32, a servo CPU 33, servo amplifiers 
34, a memory 35, an interface 36 for a teaching panel, 
and input/output devices 38 for general external 
devices. The memory 35 includes a ROM storing sys- 
tem programs, a RAM for temporarily storing data, and 
a nonvolatile memory storing various program data 
defining system operations (motions of the robot RB). 
[001 7] A teaching panel 37, which is connected to the 
teaching panel interface 36, is used for inputting, modi- 
fying and registering program data, and for manually 
inputting a manual feed (jog feed) command, a playback 
operation command, etc. To the input/output devices 38 
for external devices are connected a mechanical brake 
for the robot RB, as well as various external devices 
(e.g., a welding power supply unit) matching intended 
applications. 

[001 8] During execution of playback operation or man- 
ual feed (jog feed) operation, the host CPU 31 creates 
motion commands for servomotors SM associated with 
the respective axes of the robot RB and outputs the 
commands to the shared RAM 32. The servo CPU 33 
reads out the commands at short intervals of time, and, 
based on position signals (feedback signals) supplied 
from position detectors (pulse coders PCs) of the 
respective axes of the robot, executes servo processing 
and outputs current commands to the servo amplifiers 
34 of the respective axes, to drive the servomotors of 
the respective robot axes. Further, based on the posi- 
tion signals (feedback signals) supplied from the pulse 
coders PCs of the respective robot axes, the servo CPU 
33 periodically writes current positions of the respective 
robot axes in the shared RAM 32. The servo amplifier 
34, the servomotor SM and the pulse coder PC shown 
in FIG. 1 are those associated with one robot axis only, 
and those associated with the other axes are omitted 
from the figure. 

[0019] The configuration and functions described 
above are not particularly different from those of an ordi- 
nary robot system. This embodiment differs from con- 
ventional systems in that the memory 35 stores therein 
program data defining a process for sensing an abnor- 
mal motion of the robot and stopping the robot, and 
related set values. 

[0020] FIGS. 2 through 6 are flowcharts summarizing 
processings executed by the robot controller 30 to 
which the present invention is applied. In the following, 



3 



EP 0 927 612 A1 



the individual processes will be described with refer- 
ence to FIGS. 2 through 6 as well as to FIGS. 7 and 8 
relating thereto. 

[Process I (FIG. 2)1. s 

[0021 ] This process is a process for internally creating 
criteria for abnormal motion detection in accordance 
with data in a taught motion program and specified over- 
ride conditions, and the contents of the individual steps 10 
of the process are explained below. The process I of this 
embodiment is executed each time a motion instruction 
statement in the motion program is read but following a 
playback operation start command. However, when a 
motion program is specified, criteria for abnormal 15 
motion detection matching such specified motion pro- 
gram may be created beforehand aside from the play- 
back operation start command. 

(51) : One block of data is read out from the motion 20 
program. 

(52) : If the type of motion specified is a respective 
axes motion, the flow proceeds to Step S3; if not, 
the flow proceeds to Step S4. 

(53) : In accordance with the velocity specified in 2s 
the motion program and a set override value, an 
allowable velocity Vaj for each axis Qth axis) is cal- 
culated and set. The allowable velocity Vaj may be 

set in common for some or all of the axes. Provided 
the programmed velocity is Vpr and the override 30 
value is a, for example, the allowable velocity Vaj is 
obtained by multiplying Vbj by a coefficient k1, 
greater than "1" (e.g., "1.2"), Vbj being a maximum 
value of axis velocity calculated based on aVpr. 

(54) : If the specified motion type is circular-arc 35 
motion, the flow proceeds to Step S5; if not, the flow 
proceeds to Step S8. 

(55) : In accordance with the velocity specified in 
the motion program and a set override value, an 
allowable velocity Va1 for the end effector is calcu- 40 
lated and set. For example, provided the pro- 
grammed velocity is Vpr and the override value is a, 

the allowable velocity Va1 is obtained by multiplying 
Vc1 by a coefficient k2, greater than "1 " (e.g.. "1 .2"), 
Vc1 being a maximum velocity of the end effector 45 
calculated based on aVpr. 

(56) : An allowable acceleration Aa1 for the end 
effector is read out from preset parameters and is 
set. 

(57) : An allowable velocity Vaj for each axis (jth so 
axis) is calculated and set. The allowable velocity 

Vaj is calculated based on current position data of 
each axis (read out from the shared RAM 32) and 
Jacobian data. As is well known in the art, Jacobian 
data is essential to the calculation of inverse trans- 55 
form for creating motion commands for the respec- 
tive axes of the robot and is taught in advance to the 
robot controller. 



(58) : In accordance with the velocity specified in 
the motion program and a set override value, an 
allowable velocity Va1 for the end effector is calcu- 
lated and set. For example, provided the pro- 
grammed velocity is Vpr and the override value is a, 
the allowable velocity Va1 is obtained by multiplying 
Vd1 by a coefficient k3, greater than "1" (e.g.. 
"1 .2"), Vd1 being an end effector velocity value cal- 
culated based on aVpr. 

(59) : An allowable acceleration Aa1 for the end 
effector is read out from preset parameters and is 
set. 

(510) : An allowable velocity Vaj for each axis (jth 
axis) is calculated and set The allowable velocity 
Vaj is calculated based on current position data of 
each axis (read out from the shared RAM 32) and 
Jacobian data, as in Step S7. 

(51 1) : A velocity vector error angle limit value Kav 
for the end effector is read out from preset parame- 
ters and is set 

(512) : An allowable distance limit value D1 for the 
end effector is read out from preset parameters and 
is set The allowable distance limit value D1 is a 
limit value for the amount of deviation of the position 
of the end effector (position of the tool center point) 
from a taught path. 

(513) : Comparison is made between a taught path 
of a current cycle and a taught path of an immedi- 
ately preceding cycle to determine whether or not 
the current position is on a corner. If the angle of 
intersection of the two taught paths is greater than 
a preset threshold angle (e.g., 30°), for example, it 
is determined that the current position is on a cor- 
ner. Alternatively, since two or more motions over- 
lap at a corner, overlapping of two or more motions 
may be detected on a software basis to determine a 
corner. Only when it is determined that the current 
position is on a corner, Step S14 is executed. 

(514) : An allowable distance limit value Dcorner 
and a velocity vector error angle limit value Kcorner 
for the corner are set. In general, Dcorner is set as 
an increment to D1 , and Kcorner is set as an incre- 
ment to Kav. 

[0022] The values of Dcorner and Kcorner may either 
be variable dependent on conditions such as velocity, 
corner angle, etc., or be fixed in order to reduce the vol- 
ume of calculation. 

[0023] In the process I described above, criteria for 
detecting various abnormal motions of the robot are set 
in accordance with the type of motion specified in a 
taught interval concerned. The state in which such set- 
tings have been completed is referred to as state A. It 
should be noted here that the process I is executed 
while the robot is in motion (in the vicinity of the end of 
a preceding taught path), except at the start of the 
robot. Taking this into account, processes II to IV for 
detecting abnormality in motion will be described. 
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[Process II (FIG. 3)] 

[0024] This process is part of a process for detecting 
an abnormal motion by using the abnormal motion 
detection criteria created in the process I. The steps in s 
the flowchart are numbered in consideration of process 
sequence at the start of the robot and the contents 
thereof are explained in consistency with the process 
sequence. 

10 

(T1): Based on the difference between position 
data read out from the shared RAM 32 in the pre- 
ceding cycle and position data read out from the 
shared RAM 32 in the current cycle, a current mov- 
ing velocity V1 of the end effector is calculated. 15 
(T2): If the specified type of motion is the respective 
axes motion, the flow proceeds to a processing 
cycle (described later) labeled B; if not, the flow pro- 
ceeds to Step T3. 

(T3): With regard to the end effector, its current 20 
velocity V1 is compared with the allowable velocity 
(limit value) Va1 set in the process I. If the former is 
greater than the latter, the flow proceeds to a proc- 
ess (robot stopping process as described later) 
labeled D; if not, the flow proceeds to Step T4. 25 
(T4): Based on the difference between a moving 
velocity of the end effector calculated in the preced- 
ing cycle and that calculated in the current cycle, a 
current acceleration A1 of the end effector is calcu- 
lated. 30 
(T5): With respect to the end effector, its current 
acceleration A1 is compared with the allowable 
acceleration (limit value) Aa1 set in the process L If 
the former is greater than the latter, the flow pro- 
ceeds to the process (robot stopping process, 35 
described later) labeled D; if not, the flow proceeds 
to the processing cycle (described later) labeled B. 
(T6): In this step, which starts following the entry to 
a state labeled E (described later), a lapse of a time 
period AT equivalent to an ITP (calculation period), 40 
is measured, and then the flow proceeds to Step 
T7. 

(T7): If the robot is in motion, the flow proceeds to 
Step T8. If the robot is not in motion, the flow 
returns to Step T6 to wait for another calculation 45 
period. 

(T8): Position data of the respective axes of the 
motors are read from the shared RAM 32, and 
based on the read data, the position (including ori- 
entation) L1 of the end effector is calculated from a so 
robot reference position. The robot reference posi- 
tion is, for example, the origin of a base coordinate 
system set with respect to the robot. L1 can be 
obtained through calculations of forward transfor- 
mations with respect to the respective axis posi- ss 
tions and based on the set data of a tool coordinate 
system. 

(T9): Position data of the end effector, angle data of 




the respective axes of the robot and the accelera- 
tion data of the end effector, all stored in memory in 
the preceding cycle, are read out from the memory, 
and the flow proceeds to Step T1 . Step T1 and the 
subsequent steps, which follow Step T9, are exe- 
cuted this time based on the latest results obtained 
in the process I. 

[Process III (FIGS. 4 & 7)] 

[0025] This process is a processing cycle which is 
started from a state B in the process ll. However. Step 
M10 for stopping the robot can be started from the route 
labeled D. 

(M1): Based on the difference between the position 
data of each axis read out from the shared RAM 32 
in the preceding cycle and that read out from the 
shared RAM 32 in the current cycle, a current 
velocity Vj of each axis is calculated. 
(M2): With respect to each of the axes, the current 
velocity Vj is compared with the allowable axis 
velocity (limit value) Vaj set in the process I. If the 
former is greater than the latter, the flow proceeds 
to Step M10 to stop the robot; if not, the flow pro- 
ceeds to Step M3. 

(M3): If the specified motion type is straight-line 
motion, the flow proceeds to Step M4; if not, the 
flow proceeds to a processing cycle (described 
later) labeled C. 

(M4): Based on position data of start and end points 
A and B specified in the programmed motion state- 
ment, a reference velocity vector Ha (standardized 
as a unit vector) from the start point to the end 
point, as shown in FIG. 7, is calculated. 
(M5): Based on the difference between the end 
effector position calculated from the position data of 
the respective axes read out from the shared RAM 
32 in the preceding cycle and that calculated from 
the position data of the respective axes read out 
from the shared RAM 32 in the current cycle, a cur- 
rent velocity vector Hv (standardized as a unit vec- 
tor), as shown in FIG. 7, is calculated. 
(M6): Based on the outer product of the vectors Ha 
and Hv, an angle Kv between the vectors Ha and 
Hv is calculated, as shown in FIG. 7. 
(M7): It is determined whether or not the robot is 
currently passing a corner (in the vicinity of a cor- 
ner). For example, if the distance from the position 
at which the current position was determined to be 
on a corner in Step S13 in the process I is smaller 
than or equal to a predetermined small value, it is 
determined that the robot is currently passing a cor- 
ner. If the robot is determined to be passing a cor- 
ner, the flow proceeds to Step M8; if not, the flow 
proceeds to Step M9. 

(M8): The limit angle Kav is updated by adding 
thereto Kcorner set in the process I. 
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(M9): The current value Kv is compared with the 
limit angle Kav. tf the former is greater than the lat- 
ter, the flow proceeds to Step M 1 0 to stop the robot; 
if not the flow proceeds to the process labeled C. 
(M10): This process is executed when an abnormal s 
motion of the robot is detected, in which an alarm 
signal is output, the mechanical brake is set opera- 
tive, and the servo power supply is cut off. 

[Process IV (FIGS. 5 & 8)] io 

[0026] This process is a processing cycle starts from 
a state C in the process III. 

(F1): If the type of motion is straight-line motion, the is 
flow proceeds to Step F2, and if not (i.e., circular- 
arc motion), the flew proceeds to Step F7. 
(F2): Position data of the start and end points A and 
B specified in the programmed motion statement 
are read. 20 
(F3): As shown in FIG. 8, a line segment Lac is 
obtained from the start point A and, the current 
position C; a line segment Lbc is obtained from the 
end point B and the current position C, and based 
on the line segments thus obtained, a line segment 25 
Lditt perpendicular to the line segment AB is 
obtained. 

(F4): It is determined whether or not the robot is 
currently passing a corner (in the vicinity of a cor- 
ner); in a manner similar to Step M7 in the process 30 
III. If the robot is currently passing a corner (in the 
vicinity of a corner), the flow proceeds to Step F5; if 
not. the flow proceeds to Step F6. 
(F5): The limit distance D1 is updated by adding 
thereto Dcorner set in the process I. 35 
(F6): The current length of Lditt is compared with 
the limit distance D1 . If the former is longer than the 
latter, the flow proceeds to Step M10 to stop the 
robot; if not, the flow proceeds to Step F7. 
(F7): The current position data L1 of the distal end 40 
of the robot (obtained in Step T8 in the process II), 
the angle data Vj of the respective axes, the current 
velocity VI, and the current acceleration A1 are 
stored in memory (labeled F), and the flow pro- 
ceeds to stage labeled E. As mentioned above, 45 
from the stage labeled E, the flow proceeds to Step 
T6inthe process II. 

[0027] The foregoing describes the processes exe- 
cuted within the robot controller during a program play- so 
back operation. In the event any of the aforementioned 
various types of abnormal motions occurs, such abnor- 
mality is immediately detected by the processes 
described above and the robot comes to a stop, so that 
safety is secured. 55 
[0028] In the case of manual feed operation, a process 
V illustrated in the flowchart of FIG. 6 may be executed 
as a process equivalent to the process I. It should be 



noted that in general, manual feed operation involves 
no circular-arc motion. (The result of determination 
according to a straight fine or respective axes is output 
in motion type determination step). 

[Process V (FIG. 6)] 

[0029] This process is one for internally creating 
abnormal motion detection criteria for manual operation 
in accordance with manual feed conditions (related set 
conditions including manual operation mode, such as 
straight-line feed or respective axes feed and manual 
feed velocity specified by means of the teaching panel, 
and override for the manual feed velocity, etc.), and the 
contents of the individual steps thereof are explained 
below. 

(G1): Manual feed conditions are read out 
(G2): If the motion type condition specified is the 
respective axes motion, the f tow proceeds to Step 
G3; if not, the flow proceeds to Step G4. 
(G3): Based on related set conditions such as a 
specified manual feed velocity and an override 
value to the manual feed velocity, an allowable 
velocity Vaj for each axis (jth axis) is calculated and 
set. The allowable velocity Vaj may be set in com- 
mon for some or ail of the axes. Provided the set 
manual feed velocity is Vmn and the override value 
is p, for example, the allowable velocity Vaj is 
obtained by multiplying Vfj by a coefficient k3, 
greater than "1" (e.g., "1.2"), Vfj being a maximum 
value of axis velocity calculated based on pVmn. 
(G4): Based on the related set conditions such as a 
specified manual feed velocity and an override 
value to the manual feed velocity, an allowable 
velocity Va1 for the end effector is calculated and 
set. For example, provided the set manual feed 
velocity is Vmq and the override value is y, the 
allowable velocity Val is obtained by multiplying a 
velocity value, which is calculated based on yVmq, 
by a coefficient k4, greater than "1" (e.g., "1.2"). 
(G5): An allowable acceleration Aal for the end 
effector is read out from preset parameters and is 
set. 

(G6): An allowable velocity Vaj for each axis Qth 
axis) is calculated and set, in a manner similar to 
Step S10 in the process I. 

(G7): A velocity vector error angle limit value Kav for 
the end effector (value set for manual feed opera- 
tion) is read out from preset parameters and is set. 
(G8): An allowable distance limit value D1 for the 
end effector (value set for manual feed operation) is 
read out from preset parameters and is set. 

[0030] According to the process V described above, 
criteria for detecting various abnormal motions of the 
robot are set in accordance with current manual feed 
conditions. The state in which such settings have been 
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completed is regarded as the aforementioned state A 
and the processes II to IV are then executed, whereby, 
in the event any of the aforementioned various types of 
abnormal motions takes place during manual operation, 
such abnormality is immediately detected and the robot 5 
comes to a stop, thus ensuring safety. 
[0031] According to the present invention, when the 
point representative of the position of a robot, which is 
making motions in program playback operation mode or 
manual operation mode, shows an abnormal velocity, 10 
an abnormal acceleration, an abnormal change of ori- 
entation, or an abnormal movement path in space, such 
abnormality can be quickly and automatically sensed, 
and the robot is stopped to thereby avoid danger. 

15 

Claims 

1. A robot controller for controlling a robot driven by 
means of robot axes, each provided with a position 
detector, comprising: 20 

abnormal motion detection index creating 
means for creating an abnormal motion detec- 
tion index for detecting an abnormal motion of 
a point representative of position of said robot 25 
in space, based on present position data of the 
robot axes obtained from outputs of the posi- 
tion detectors for the robot axes while said 
robot is in motion; 

determining means for comparing said abnor- 30 
mal motion detection index with a predeter- 
mined abnormal motion detection reference, 
and determining an abnormal motion when 
said abnormal motion detection index is 
greater than the predetermined abnormal 35 
motion detection reference; and 
stopping means for immediately stopping 
motion of said robot when the abnormal motion 
of the robot is detected by said determining 
means. 40 

2. The robot controller according to claim 1, wherein 
said abnormal motion detection index includes an 
index indicative of moving velocity of the position- 
representative point of said robot, and the abnormal 45 
motion detection reference includes a reference 
value for discriminating abnormality of moving 
velocity of the robot position-representative point. 




said abnormal motion detection index includes an 
index representing angular velocity of a wrist axis of 
said robot, and said abnormal motion detection ref- 
erence includes a reference value for discriminating 
abnormality of angular velocity of the wrist axis of 
said robot 

5. The robot controller according to claim 1, wherein 
said abnormal motion detection index includes an 
index representing direction of movement of said 
position-representative point during a path control 
of said robot and the abnormal motion detection 
reference includes a reference value for discrimi- 
nating abnormality in direction of movement of said 
position-representative point. 

6. The robot controller according to claim 1 , wherein 
said abnormal motion detection index includes an 
index representing a position of said position-repre- 
sentative point during a path control of said robot, 
and said abnormal motion detection reference 
includes a reference value for discriminating abnor- 
mality of the position of said position-representative 
point. 

7. The robot controller according to any one of claims 
1 through 6, further comprising means for automat- 
ically creating said abnormal motion detection ref- 
erence based on data in a taught motion program. 

8. The robot controller according to any one of claims 
1 through 6, further comprising means for automat- 
ically creating said abnormal motion detection ref- 
erence based on data in a taught motion program 
and an override condition. 

9. The robot controller according to any one of claims 
1 through 6, further comprising means for automat- 
ically creating said abnormal motion detection ref- 
erence based on a preset manual operation 
condition. 



3. The robot controller according to claim 1, wherein so 
said abnormal motion detection index includes an 
index indicative of an acceleration of said position- 
representative point, and said abnormal motion 
detection reference includes a reference value for 
discriminating abnormality of acceleration of said 55 
position-representative point. 

4. The robot controller according to claim 1 , wherein 
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